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(57) The position of 8 satellite 102 in a satellite 
based navigation syatem 200 is determined without 
reilanceon sateilite ephemerfs data. Orbital 
parameters are computed for each aateilite 102. The 
orbital parameters can then be used to predict the 
^position of each^sateOite 102 at any tima 
Subsequent ephemeris data may be compared to a 
predicted satellite position to determine whether the 
ephemeris data is corrupt The orbital parameters 
may be determined by: computing a pseudorange 
and a yeftodty for a selected satellite 102 for a 
plurality of timesr computing at least three estimated 
positions of the satellite 102 from the pseudoranges 
and velocities, and computing orbital parameters for 
the satellite from the three estimated positions. In 
another embodiment the orbital parameters era 
determined by: determining the position of a 
receWer 212 for atleest three times using a 
constellation of satellites 102, using the three 
receiver positions to triangulate on an average 
position for the selected satellite 102 in the 
constellation, repeating these steps until at least 
three mean satellite positions have been computed, 
computing the orbital parameters from the three 
mean positions of the selected sateilite 102. 
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Method and Apparatus for Predicting the Position of 
A Satellite in a Satellite based Navigation System 



This invention relates generally to the field of navigation systems which 
use a constellation of Earth-oibitiitg satdlltes to detennine the position of a 
recover at or near the Eanh's surface. More q)ecifically, the invention relates 
to a method and ^paratus for predicting the position of each satellite in the 
constellation. 



Several national governments, including the United States (U.S.) of 
America, are presently developing a terrestrial position determination system, 
referred to generically as a global positioning system (GPS). A GPS is a 
satellite-based radio-navigation system which is intended to provide hi^ly 
accurate three-dimensional position information to receivers at or near the 
sur&oe of the Earth. 

The U.S. government has designated its GPS the "NAVSTAR." The 
NAVSTAR GPS is expected to be declared fully operational by die U.S. 
government in 1993. The government of tiie former Union of Soviet Socialist 
Republics (U.S.S.R.) is engaged in tiie develq>ment of a GPS known as 
"GLONASS". Furtiwr, two European systems known as "NAVSAT" and 
"GRANAS" are also under development. For ease of discussion, tiie 
following disclosure focuses specifically on tiie NAVSTAR GPS. The 
invention, however, has equal applicability to otiier global positioning systems. 

In tiie NAVSTAR GPS, it is envisioned tiiat four orbiting GPS 
satellites will exist in each of six separate circular orbits to yield a total of 
twenty-four GPS satellites. Of Uiese, twenty-one will be operational and tfjree 
will serve as spares. The satellite orbits will be neitiier polar nor equatorial 
but will lie in mutually ortiiogonal inclined planes. 
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Each GPS satellite will orbit the Earth approximately once every 12 
hours. This coupled with the £aa that the Earth rotates on its axis once every 
twenty-four hours causes each satellite to complete exactly two orbits while the 
Earth turns one revolution. 
S The position of each satellite at any given time will be precisely known 

and will be continuously transmitted to the Earth. This position information^ 
which indicates the position of the satellite in space with respect to dme (GPS 
time), is known as ephttams data. 

In addition to the ephemeris data, the navigation signal transmitted by 
10 each satellite includes a precise time at which die signal was transmitted, llie . 
distance or range from a receiver to each satellite may be determined from tiiis 
time of transmission which is included in each navigation signal. By noting 
the time at which die signal was received at the receiver, a propagation time 
delay can be calculated. This time delay when multiplied by the speed of 
15 propagation of die signal will yield a "pseudorange" from the transmitting 
satellite to the receiver. 

The range is called a "ps^ifttoange" because die receiver clock may 
not be precisely synchronized tt> GPS time and because propagation tiirough 
the atmosphere introduces delays into the navigation signal propagation times. 
20 These result, req)ectively, in a clock bias (error) and an atmospheric bias 
(error). Clock biases may be as large as several milliseconds. 

Using diese two pieces of information (the ephemeris data and die 
pseudorange) from at least diree satellites* the position of a receiver widi 
reject to die center of die Eardi can be determined using passive triangulation 
25 tediniques. 

Triangulation involves three steps. First, the position of at least three 
satellites in "view" of the receiver must be determined. Second, the distance 
from die receiver to each satellite must be determined. Finally, die 
information from die first two steps is used to geometrically determine the 
30 position of die receiver with respect to the center of the Earth. 
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Triangulation, using at least three of the orbiting GPS satellites, allows 
the absolute terrestrial position Oongitude. latitude, and altitude with respect 
to the Earth's center) of any Earth receiver to be computed via simple 
geometric theory. The accuracy of the position estimate depends in part on 
5 the number of orbiting GPS satellites that are sampled. Using more GPS 
satellites in the computation can increase the accuracy of the terrestrial 
position estimate. 

Conventionally, four GPS satellites are sampled to determine each 
terrestrial position estimate. Three of the satellites are used for triangulation, 
10 and a fourth is added to correct for the dock bias described above. If the 
receiver's clock were predsely synchronized witfi that of the GPS satellites, 
then this fourth satellite would not be necessary. However, precise (e.g„ 
abmic) clocks are expensive and are, therefore, not suitable for all 
applications. , 

15 For a more detailed discussion on the NAVSTAR GPS. see Paridnson, 

Bradford W. and Gilbert. Stephen W.. "NAVSTAR: Global Positioning 
System - Ten Years Later," PmceetSngs of the IEEE, Vol. 71, No. 10, 
October 1983; and GfS; A (Mde w the Next Wttty, pnb\\shed by TmeMc 
Navigation Ltd., Sunnyvale, California, 1989, pp. 1-47, both of which are 

20 incorporated herein by reference. For a detailed discussion of a vehicle 
positioning/navigation system which uses the NAVSTAR GPS. see commonly 
owned U.S. PSL AppL Scr. No. 07/628460. entitled "Vehicle Position 
Determination System and Method," filed December 3. 1990. which is 
incorporated hernn by reference. 

25 In the NAVSTAR GPS. the electromagnetic signals from each satellite 

are continuously transmitted using a single carrier frequency. Each satellite, 
however, uses a different modulation gold code to allow differentiation of the 
signals. The carrier frequency is modulated using a pseudorandom signal 
which is unique to each GPS satellite. Consequently, the ortiiting GPS 

30 satellites can be identified when the navigation signals are demodulated. 



Furthermore, the NAVSTAR GPS envisions two modes of modulation 
for the carrier wave using pseudorandom signals. In the first mode, the 
carrier is modulated by a **C/A signal** and is referred to as the 
"Coarse/ Acquisition mode". The Coarse/ Acquisition or C/A mode is also 
known as the "Standard Positioning Service". The C/A signal is a gold code 
sequence having a chip rate of 1.023 MHz. Gold code sequences are known 
in the art. 

A chip is one individual pulse of the pseudorandom code. The chip 
rate of a pseudorandom code sequence is the rate at whidi the diips in the 
sequence are generated. Consequently, tte chip rate is equal to the code 
repetition rate divided by the number of members in the code. With reflect 
to the C/A mode of the NAVSTAR GPS, there exists 1,023 chips in each gold 
code sequence and the sequence is repeated once every millisecond. Use of 
the 1.023 MHz gold code sequence from four orbiting GPS satellites enables 
the terrestrial position of an Earth receiver to be determined to an approximate 
accuracy of within 60 to 100 meters (widi 95% confidence). 

The second mode of modulation in the NAVSTAR GPS is commcmly 
referred to as the "precise* or "protected" (P) mode. In the P-mode« the 
pseudorandom code has a chip rate of 10.23 MHz. Moreover, the P-mode 
sequences are extremely long, so that the sequences repeat no more than once 
every 267 days. As a result, the terrestrial position of any Earth receiver call 
be determined to within an approximate accuracy of 16 meters (spherical error 
probable). The P-mode is also known as the "Precise Positioning Service". 

The P-mode sequences are held in secrecy by the United States 
government and are not made publicly available. The P-mode is intended for 
use only by Earth receivers q>ecifically authorized by the United States 
government. 

Thus, given that the P*mode modulated data is generally not available, 
many GPS users must rely solely on the GPS data provided via the C/A mode 
of modulation. The U.S. government (the operator of the NAVSTAR GPS) 
may at certain times introduce errors into the C/A mode GPS data being 



uansmitted from the GPS satellites by changing clock and/or ephemeris 
parameten. That is, the U.S. government can selectively corrupt the GPS 
data. This is known as "selective availability" or simply SA. SA may be 
activated for a variety of reasons, such as national security. 

When SA is activated, the U.S. government is still able to use the 
NAVSTAR GPS because the U.S. govemmem has access to the P-mode 
modulation codes. The aA mode data, however, may be rendered 
substantially less accurate. When this occurs, it is important for a navigation 
system which relies on the C/A mode of GPS to be capable of recognizing the 
corrupt data. 

Further, the U.S. government may use varying degrees of selective 
availabili^. The q)hemeris and/or the clock parameters for one or more 
satellites may be slightly or substantially modified. 

In addition to selective availability, any one of the GPS satellites may 
malfunction and transmit erroneous data. Other errors may be induced into 
the GPS signals from atmospheric effects, receiver noise, reflections, shading, 
satellite path shifting, etcetera. The incorrect data resulting tiierefrom may 
result in computation of incorrect pseudoranges and incorrect satellite positions 
by a receiver. 

In such circumstances, it is desirable to recognize the bad satellite data 
and, if possible, compensate for it to prevent erroneous position estimates. 

GPS receiver systems may be eitiier open-ended or differential (as 
discussed below). A differential GPS system will substantially reduce tiie 
effects of many of die errors discussed above. However, to reduce die effects 
of these errors further and for non-differential GPS ^stems, it is desirable to 
recognize die bad satellite data and, if possible, compensate for it to prevent 
erroneous position estimates. 



The invention is an apparatus and method for use with a satellite based 
navigation system. The invention allows the position of a satellite to be 
determined without reliance on the satellite ephemeris data. Alternatively, the 
invention may be used to continuously monitor the integrity of the ephemeris 
data received from a satellite. 

Orbital parameters are oonq[>uted for each satellite. The orbital 
parameters can then be used to predict die position of each satellite at any 
time« In a first embodiment, the orbital parameters may be determined by: 
computing a pseudorange and a velocity for a selected satellite for a plurality 
of times, using the pseudoianges and velocities to compute at least three 
estimated positions of the satellite, and using the three estimated positions to 
compute orbital parameters for tiie satellite. 

In another embodiment, the orbital parameters are determined by: 
using a constellation of satellites to determine the position of a receiver for at 
least three times, using tfie three receiver positions to triangulate on an 
average position for tiie selected satellite in die constellation, repeating diese 
steps until at least tiiree mean satellite positions have been computed, 
computing die orbital parameters from die three mean positions of the selected 
satellite. 

In the drawings:- 

FIG. 1 is a diagram depicting die NAVSTAR GPS satellites in dieir 
respective orbits around die Eardi; 

FIG. 2 is a diagram illustrating an autonomous vehicle system whidi 
includes a constellation of four GPS satellites, a pseudolite, a base station, and 
an autonomous vehicle; 

FIG. 3 is a block diagram of the autonomous vehicle system detailing 
die vehicle positioning system of the autonomous vehicle; 

FIG. 4 is a block diagram of a GPS processing system; 



FIG. 5 is a diagram showing the geometric relationship between the 
center of the Earth, a vehicle near the surftux of the Earth and a constellation 
of GPS satellites; 

FIG. 6 is a flow chan illustrating the st^s of computing a best position 
estimate for a vehicle; 

FIG. 7 is a flow chart illustradng the method of the invention; 

FIG. 8 is a flow chart illustrating the steps of a first embodiment of the 
invention for predicting the orbital parameters of a satellite; 

FIG. 9 is a flow chart illustradng the stq>s of the invention for 
monitoring the integrity of GPS q>henieris data and for refining the predicted' 
orbital parameters for a satellite; and 

FIG. 10 is a flow chart illustrating die stq>s of a second embodiment 
of die invention for predicting the orbital parameters of a satellite; 



The present invention is now described with reference to the figures 
where like reference numbers denote like elements/jteps. 

The invention is a method and a^iparanis for monitoring the int^rity 
of position data received from a satellite based navi^ttion systmn. In die 
preferred embodiment, die NAVSTAR Global Positioning System (GPS) is • 
used. As discussed above and illustrated in Figure 1, die NAVSTAR GPS 
includes twenty-one operational satellites 102 which ori>it the Earth in six 
ort>its 104. 

The invention is described in the environment of an autonomous vehicle 
system 200 as shown in Figure 2. A r^resentative GPS constellation 202 
includes four GPS satellites 102(a)-102(d) for transmitting GPS data. A 
vehicle (e.g., an autonomous mining truck) 210 and a base station 220 are 
adapted to receive die GPS data/navigation signals fn>m each GPS satellite 102 
in die constellation using respective GPS antennas 212 and 222. 

A GPS receiver can receive GPS navigation signals from a satellite 
which is "in view" of die receiver (i.e., line of sight communications). For 



example, "in view" may be defined as any satellite that is at least ten degrees 
up from the horizon. The ten degree angle provides a buffer zone between a 
useful, in view satellite and a satellite which is just passing out of view below 
the horizon. 

A "constellation" is a group of satellites selected from the satellites "in 
view" of a GPS receiver. For example, four satellites may be selected from 
a group of six which are in view of a GPS receiver. The four satellites are 
normally selected 1>ecause of a favorable geometry for triangulation (discussed 
below). 

Base station 220 includes a GPS receiver which is located at a known, 

fixed position. Base station 220 communicates with vehicle 210 over 
communications channel 225. 

Communication channel 225 represents the communications link 
between base station 220 and vehicle 210. In the preferred embodiment, 
communication channel 225 comprises radio transceivers. Communication 
channel 225 is used to transfer data between base station 220 and vehicle 210. 

System 200 may optionally include one or more pseudolites 230. A 
"pseudolite" is a transmitting system located on or near the Earth's sur&ce 
which emulates a GPS satellite. Because a pseudolite has a fixed, known 
position, it can greatly enhance the position estimates derived from GPS. For 

■ 

ease of discussion heiein, only GPS satellites 102 will be referenced. It 
should be understood, however, that where pontion data from a sateltitB is 
requited, pseudolite data may be substituted. 

Figure 3 shows a high-level block diagiam of ^stem 200 of die 
invention. Including GPS satellites 102, vehicle 210, base station 220, and 
pseudolites 230. Vehicle 210 includes a vehicle positioning system (VPS) 310 
and a navigation system 320. 
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VEHICLE PosmONWC SYSTEM (VPS) 310 

The task of guiding vehicle 210 along a prescribed path requires, 
among other things, an accurate estimate of the vehicle's current position 
relative to some reference point. Once the current position is known, vehicle 
5 310 can be commanded to proceed to its next destination. VPS 310 allows 
position estimates of vehicle 210 to be determined with extreme precision. 

VPS 310 includes a GPS processing system 312 and a motion 
positioning system (MPS) 314. GPS processing system 312 receives GPS 
data, i.e., navigation signals, from GPS satellites 102 and computes a first 
10 position estimate (FPE) for vehicle 210 therefrom. MPS 314 includes a 
vehicle odometer 316 and an inenial reference unit ORU) 318 which track the 
position of the vehicle based on changes from an initial known position. MPS 
314 produces (the actual computations are done in VPS processing system 
324) a second position estimate for vehicle 210. The first position estimate 
IS and the second position estimate are indq)endently derived. 

The first position estimate (from GPS) may be used as an independent 
indication of the position of vehicle 210. Similariy, the second position 
estimate (from MPS) may be used as an independent indication of the position 
of vehicle 210. In the preferred embodiment, however, the first and second 
20 posidon estimates are combined by a VPS processing system 324 (as discussed 
below) to produce a more accurate third or best position estimate. 

Navigation System 320 

Navigation system 320 receives die third position estimate from VPS 
314. Navigation system 320 uses this precise, third position estimate to 
25 accurately navigate vehicle 210. 

GPS Processing System 312 

GPS processing system 312 is the heart of system 200. With reference 
to Figure 4, GPS processing system 312 includes a receiver system 400 and 
a GPS processor 408. Receiver system 400 receives and decodes the 
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navigadon signals from the satellites. GPS processor 408 then uses the 
information from receiver system 400 to compute the first position estimate. 

Receiver system 400 includes a GPS antenna 402. a preamplifier 404, 
and a GPS receiver 406. Antenna 402 is adapted to receive electromagnedc 
radiation in the radio portion of die qiectrum. Preamplifier 404 amplifies a 
GPS navigation signal received by GPS antenna 402 from a selected GPS 
satellite. GPS receiver 406 is a multi-channel receiver which decodes die GPS 
navigation signals and produces a pseudorange and a satellite position for each 
selected satellite. GPS processor 408 uses die psradoranges and satellite 
positions for a pluraliQr of satellites to calculate the first position estimate for 
vehicle 210. 

In the preferred embodiment, antenna 402 and preamplifier 404 are 
integrated into a single unit. The combined antenna/preamplifier 402/404 and 
receiver 406 are available together under part number MX4200 from 
Magnavox Advanced Products and Systems Co., Torrenoe, California. GPS 
processor 408 includes an MC68Q20 microprocessor, available from Motorola, 
Inc., of Schaumbuig, Ulinois. 

Receiver 406 oonqiutes a pseudoranges for each satellite as follows. 
As described above, each signal transmitted by a GPS satellite is continuously 
oicoded with the exact time at which the signal was transmitted. By noting 
the time at which die signal was received at receiver 406, a prq)agation time 
delay can be computed. This time delay when multiplied by die speed of 
propagation of die signal a9979245998 x 10* m/s) will yield the pseudorange 
ftom die transmitting satellite to die receiver. As discussed above, die range 
is called a 'pseudotaBgit'' because die receiver dock is not precisely 
synchronized to GPS time (causing a clock error) and because propagation 
dirough die different layers of die atmoq>here changes die speed of die 
propagating signals (causing an atmospheric error). 

GPS receiver 406 may use an almanac to roughly determine die 
position of a satellite (e.g., for acquisition purposes). For a more piedse 
determination of satellite position, die receiver decodes die GPS navigation 



I 

-11- 

slgnal and extracts ephemeris data therefirom. The ephemeris data indicates 
the precise position of the transmitting satellite. 

GPS processor 408 calculates the first position estimate using the 
pseudoranges and satellite positions from GPS receiver 406. This is described 
5 below with reference to Figure 5. 

Figure 5 shows a sample satellite constellation 202, having GPS 
satellites 102(a)-102(d), in view of vehicle 210. In Cartesian coordinates, with 
respect to die center of tht Earth, satellite 102(a) is located at (x„y,,Zi): 
satellite 1020)) is located at (Xj.yj^ia)'* ^^^^^ (X3.y3.z3); 

10 satellite 102(d) is located at (X4.y4.l4): and vehicle 210 is located at a position 

The Cartesian (x.y.z) coordinates of each satellite 102 are determined 
by GPS receiver 406 using a satellite's ephemeris data. The pseudoranges 
(PSR,. PSRj, PSR3 and PSR4) between vehicle 210 and each satellite are 
15 determined by GPS receiver 406 using transmission time delays. Given this 
information for at least four satellites, die location of vehicle 210 Cut., 
receiver 406) may be determined using tht following four distance equations: 
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where: Be^ek * 
The "clock bias" is a zero order correction factor which attempts to 

20 compensate for die clock error discussed above. 

Note tiiat tiiere are four unknowns in tiiese equations: U,. Uy, U,, and 

Bcock- Note also that each satellite produces an equation. Thus, we have four 



satellites and four unknowns, allowing the equations to be solved for the clock 
bias (B^iock) and the position (U^.Uy.U^ of vehicle 210. 

If the clock bias (B^ioek) is eliminated, then only three variables remain 
in the equation such that only three satellites are necessary to solve for the 
position of vehicle 210. The clock bias can be eliminated if a high precision 
clock (e.g., an atomic clock) is used in receiver system 400. 

If die latitude (L) and longitude (X) of die vehicle are desired, they can 
be computed using the following equations: 



Latitude » cos*^ 



EQ.5 



u 

Langftude » tan'' — ^ EQ. 6 



Note that this latitude equation provides an approximate latitude. 
Deteimination of a more exact latitude requires that a complex iterative 
prMess be used. 

GPS Processing System 312 and Kaiman FIlterino 

* 

From a user's perspective, GPS processing system 312 is the most 
important part of the autonomous vehicle system 200. GPS processing system 
312 is re^nsible for receiving the signals from each GPS satellite, for 
selecting the optimal satellites for processing, for determining the precise 
position of each selected satellite, for determining the pseudorange to each 
satellite, and ultimately for estimating the position of tiie recdver based on die 
satellite positions and die pseudotanges. All of tiiis must be done using 
received data (of greatly attenuated amplitudes) which is most often heavily 
corrupted with noise (including noise produced by the atmosphere, the 
preamplifier and die receiver). GPS processing system 312 relies extensively 
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on Kalman Filtering to eliminate the noise from the GPS navigation signals. 
Kalman filtering is performed in GPS processor 408. 

The Kalman filter is a recursive least-squares algorithm which is 
normally implemented via software or firmware on a digital computer 
(processor 408). In the preferred embodiment, the Kalman filter assumes that 
the noisy signals are discrete rather than continuous in nature. Both the data 
and noise are modeled in vector torn, and the data is processed recuisively. 

A Kalman filter performs two functions. First, it extrapolates a data 
estimate from previous data. Second, it updates and refines die exsrapoiated 
data estimate based on current data. For example, if a vehicle position pj and - 
velocity Vj are known at time t,, tiien tiie filter (performing the extrapolation 
step) will use pi and V| to estimate a position Pj at a time u. Thereafter 
(performing the update stq>), newly acquired data at time is used to refine 
tiie position estimate P2. Data which is fed to die Kalman filter to aid in eidier 
tile extrapolation or the update/refinement stq>s is said to "constnun" the filter. 

Kalman filtering is well known in the arL For a more detailed 
discussion on Kalman filtering, see Brown, R. G., "Kalman Filtering: A 
Guided Tour/ Iowa State University: and Kao. Min H. and Eller, Donald H., 
"Multiconfiguration Kalman Filler Design for High-Performanoe GPS 
Navigation," IEEE Transactions on Automatic Control, Vol. AC-28, No. 3, 

• 

March 1983, the relevant teachings of which are incoiporated by reference. 

Conventionally, because the Kalman filter is a linear filter, the distance 
equations set forth above are not solved directly, but are first linearized. That 
is, die equations are differendated and die derivative of each equation is solved 
in order to compute a change from a last known position* For example, a first 
position estimate at time t| can be rapidly computed by GPS processor 410 by 
differentiating the navigation equations and solving for a change in position 
(AUx,AUy,AUj) from a last known vehicle position (Uj^,\Jy,V^i.i at t^.^. This 
gready simplifies the solution of the distance equations. 

As an alternative to Kalman filtering, least squares estimation or best 
fit polynomial matching may be used. 
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Base Station 220 

GPS data from constellation 202 of GPS satellites 102 is also recnved 
by base station 220. Base station 220 comprises a host processing system 328. 
Host processing system 328 is similar to GPS processing system 312 of vehicle 
210 in that it contains a GPS receiver (e.g., a Magnavox model MX4818) for 
determining the position of the base station widi respta to the center the 
Eardi. The base station is used to make a "differential GPS system". 

In a differential GPS system, a GPS computed position of die base 
station is used in conjunction widi tiie known position of die base station to 
compute biases. By producing a bias or correction fector for tadi 
pseudorange. die base station can quantify and correct errors present in die 
first position estimate. 

The base station can compute biases in a variety of ways. In die 
preferred embodiment, die GPS computed pseudorange from each satellite is 
compared to a computed distance (d) between Uie satellite and the known 
position of base station 220. The difference is a "differential bias" caused by 
atmospheric and odier errors as discussed above. The base station computes 
a bias for each satellite used in die position computations. These biases, when 
communicated to die vehicle over communication channel 225, can be used to 
improve die accuracy of first position estimate. 

The distance (d) between a satellite at a position (x,y,z) and a base 
station at a position (fi^^By^B^ is computed using die standard distance 
equation: 

(x-B/ + (y-B/ * iz'Bf - rf* EQ. 7 

The position (x,y.z) of die satellite is computed from die satellite's ephemeris 
data. 

The differential GPS system assumes diat vehicle 210 is located 
relatively close to base station 220, e.g., widiin 40 km, such diat die 
atmospheric errors present at base station 220 are approximately die same as 
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the atmospheric errors present at vehicle 210. This allows the vehicle to 
correct, i.e., improve the accuracy of, the vehicle's first position estimate 
based on information generated at the base station. 

Motion PosmowNo System (MPS) 314 

As discussed above, MPS 314 includes a vehicle odometer 316 and an 
inertial reference unit (IRU) 318 which track the posidon of the vehicle based 
on changes from an initial known posidon. The vehicle odometer 316 
produces data on the distance travelled by vehicle 210. The IRU 318 
comprises laser gyioscope(s) 320 and accelerometer(s) 322 which can be used 
to produce position, velocity, roll, pitch and yaw data. MPS 314 provides the 
IRU data and the ouometer data to VPS processing system 324. An MPS 
inter-communications processor 326 controls die format of the MPS data 
which is provided to VPS processing system 324. From this data, VPS 
processing systems 324 produces a second position estimate for vehicle 210. 

VPS PRocEssmc System 324 

As mentioned above, the first position estimate (FPE) from GPS may 
be used as an independent indication of the position of vehicle 210. Similariy, 
the second position estimate (SPE) computed from MPS data may be used as ^ 
an independent indication of die position of vehicle 210. In the preferred 
embodiment, however^ the first and second position estimates are combined 
by VPS processing system 324 to produce a more accurate third or best 
position estimate (BPE). To accomplish diis, VPS processing system relies on 
Kalman filtering and on weighted averaging to optimally combine die data 
from GPS processing system 312 widi die data from MPS 314. This method 
for producing a BPE is illustrated in a flow diart 600 of Figure 6. 

At a step 602, an optimal constellation of satellites (designated "SV 
for -space vehicle") SVpSV4 is selected. While at least four satellites are 
required, a greater number may be used to improve the accuracy of the first 
position estimate. Steps 603-607 are concerned widi producing a differential 
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bias for each satellite as discussed above. Steps 608-612 are concerned with 
using GPS data and the differential biases to compute an accurate first position 
esdnoate (FPE) and for combining the FPE with a second posiuon estimate 
(SPE) from MPS 314 to produce a third or best position estimate (BPE)« 

Computation of a differential bias at die base station proceeds as 
follows. At step 603, die ephemeris data and range data are received from 
each satellite. The pseudoiaiige (PSR) to each satellite is determined at step 
604. Then, at step 60S, the position of each satellite is computed using die 
ephemeris data and die GPS time. At steps 606« a range between eadi 
satellite and the base station is computed as discussed above using the known 
position of die base and die ephemeris indicated position of each satellite. At 
step 607, the computed pseudorange for each satellite is compared to the 
computed range between the base station and the corresponding satellite. This 
comparison yields a "differential bias" for each satellite. The differential 
biases are transmitted to die vehicle for use in computing an accurate first 
position estimate. 

Computation of a best position estimate at the vehicle proceeds as 
follows. At step 608, the q>hemeris data and range data are received fam 
each satellite. The pseudoranges (PSR*s) to each satellite are determined at 
step 609. Then, at stq> 610, die position of each satellite is computed usiiig 
die ephemeris data and die GPS time. At step 611, an FPE is computed for' 
vehicle 210 using die pseudoranges from stqp 609, the satellite positions fitom 
step 610, and the differential biases from die base station (stq> 607). Finally, 
at step 612, die second position estimate from MPS 314 and die first position 
estimate from step 611 are combined to produce a third or best position 
estimate (BPE) for vehicle 210. 

In the preferred embodiment, the FPE and die SPE are combined using 
a weighted combiner. Because die FPE is inherentiy more accurate* it Is 
normally given more weight dien die SPE. However, since bodi die FPE and 
the SPE are independentiy derived, either can be given full weight if die odier 
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becomes corrupted. The weighting factors are assigned based on the estimated 
respective accuracies. 

Note that steps 603-607 are performed at base station 220« while steps 
608-612 are performed simultaneously at vehicle 210. If desired, the raw GPS 
data (pseudoranges and satellite positions) may be transmitted from base 
station 220 to vehicle 210. All computations may tiien be carried out at 
vehicle 210. 

While this metiiod leads to a best position estimate, its accuiacy is 
dependent on tiie integrity of the GPS data from GPS satellites 102. As 
discussed above, the GPS data may be purposely corrupted by the govemmejit . 
using selective availability, or a satellite malfunction may produce erroneous 
GPS data. A differential system will sibstantially reduce the effects of these 
errors. However, it may not completely eliminate the errors. Further, a 
differential system is not always available. 

The present invention provides a system and method for accurately 
determining the position of a satellite. Generally, tiiis is accomplished by 
predicting an average orbital path for each satellite based on past data. Once 
an orbital path is predicted, the position of a satellite may be quickly 
determined. Tliis is illustrated in Figure 7. 

Figure 7 shows a flow chart 700 illustrating the steps of the present 
invention. At step 702, navigation signals are received from the constellation 
of GPS satellites. This data is tiien used at step 704 to predict an orbital path 
for each satellite in the constellation. Once the orbital parameters for the 
satellite have been predicted, the position of each satellite can be determined 
as a function of GPS time, without relying on satellite ephemeris data. This 
is illustrated at step 706. 

In a first embodiment, die position of a satellite is determined with 
indirect reliance on tiie ephemeris data from the constellation of satellites. In 
a second embodiment, the position of a satellite is determined without reliance 
on any satellite provided ephemeris data. 
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In the first embodiment of the invention, the orbital path of each 
satellite is predicted using a method 800 illustrated in Figure 8. At step 802, 
a BPE is computed for the vehicle at a time t|, where t is GPS time. At step 
804, the BPE for the vehicle is used to refine the pseudorange to the selected 
satellite (SV^). That is, since the vehicle position (U^tUy^U,)! and the satellite 
position {x,y,z)^i are accurately known at time C|, an accurate pseudorange 
(PSR|^i) may be determined ftom the following equation: 

Steps 802 and 804 are repeated, at step 806, for times t2» t), (4, and^. 
The vehicle may be in motion during this period^ or it may be stationary. 

At step 808, a first mean or average position Pj = (x^k»>^k»^k)i 
satellite SVy. is computed using the data from times t|, t2, and 13 and die 
following equation: 

for t = 

This will yield three equations, which can be used to solve for the three 
unknowns (^k* y^ic*^k)i ^^icb make up the mean position of the satellite SV|^: 

At step 810, a second mean or average position P2 = ^ 
satellite SV|^ is computed using the times t2, ^, and t4. At step 812, a tided 
mean or average position P3 = (7k*7k«^k)3 satellite SV^ is computed 
using the times t3, i^^ and t5. The three average satellite positions Pj, P2, and 
P3 are then used to predict an orbital patii of tiie satellite SV)^ at step 814. For 
example, the orbital parameters (ephemeris data) for satellite SV|^ may be 
predicted using a best fit curve metiiod (i-e., a best fit elliptical orbit is found 
which includes the three data points). 
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Three data points are the minimum which are necessary to determine 
the orbit of a satellite using a best fit curve method. Additional points n»y 
be used to improve the accuracy of the prediction. Further, alternate ways of 
predicting the orbital parameters of the satellite from the data points may be 
S used. For example, Kalman filtering may be used to predict the orbit of the 
satellite from a plurality of data points. Additional ways of predicting the 
orbital parameters will be anMuent to a those skilled in die aiL 

Once the orbit of a satellite can be predicted, the position of the 
satellite at a next time t„ can be computed using GPS time. This is illustrated 
10 at step 816. The computed GPS position can be used as the true sateilifiB 
posidon. 

Steps Z01-S14 of flow chart 800 illustrate die initiiilization of the 
invendon. Hve dme points (tpts) are used to predict the orbital parameters 
of a satellite. Once the orbit of die satellite has been predicted, the integrity 

15 of die ephemeris data from diat satellite can be chedced at each subsequent 
data point, if desired. Further, if die ephemeris data is monitored, it caa be 
used tt> continuously refine die orbital parameters for a satellite. Hiis Is 
Illustrated in flow chart 900 of Figure 9. 

At step 902, ephemeris data and pseudorange data are received from 

20 an SV at a time t^. At step 904, die GPS time and ephemeris data are used 
to compute a position of die SV. At step 906, die GPS time and die predicted 
oibital parameters are used to predict die posidon of die SV at t„. 

At step 908, die computed position of die SV from step 904 is 
compared to the predicted position of the SV firoih step 906. If the predicted 

25 position of die satellite is approximately equal to die GPS computed position, 
dien die GPS data is assumed to be VALID or GOOD and die GPS ephemeris 
data is used to compute die BPE for die vehicle at step 910. Thereafter, if 
desired, die new position data may be used to refine the predicted orbital 
parameters for the satellite at steps 914-918. 

30 At step 914, die BPE is used to refine die pseudorange for die satellite. 

At step 916, a mean position for the satellite is computed using data from 
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times t^2« ^ V ^^P ^^S* posidon of the satellite is used 

to refine the predicted orbital parameters for the satellite. The more data 
which is compiled for a satellite in this manner, the greater is the accuracy of 
the orbit prediction. 

If« at step 908, the GPS computed satellite position is not 
approximately equal to the predicted position of the satellite, then the GPS 
data is probably I^fVALID or BAD, and die predicted ephemms data is used 
to compute the next vehicle position at stq> 920. 

The above discussion has focused on the method of the invention as it 
applies to a single GPS satellite. This method, however, is repeated for ' 
additional satellites as desired. For example, if a constellation of five satellites 
is used for the navigation of an autonomous vehicle, then the method may.be 
used to monitor the integriQr of die GPS data from all five satellites in die 
constellation. 

The embodiments of the invention heretofore described smooth out 
errors in satellite position as indicated by satellite ephemeris data. That is, 
q)hemeris data is downloaded from a satellhe. GPS time is then used to 
determine the position of the satellite. A drawback to this approach is that 
precise GPS time is required to compute an accurate satellite position. 

In addition, these embodiments of the invention rely on vdiide best 
position estimates to compute die orbit of a satellite. Best position estimates 
rely on ephemeris data from die constellation of GPS satellites. Thus, the 
embodiments are based on die assumption that die initial satellite traddi^ of 
steps 802-806 occurred in die absence of corruption by selective availabili^ 
or, alternatively, that die character of die initial corruption was known. 

In the second embodiment of die invention, die average orbital padi for 
a satellite is predicted widiout using the ephemeris data from die satellite. 
Radier, "local ephemeris data" is generated for die satellite. This embodiment 
is illustrated in a flow chart 1000 shown in Figure 10. 

In a step 1002, a GPS navigation signal is received from a satellite 
(SV) at a time t^. A pseudorange (PSR) to die satellite and a satellite velocity 
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is determined at step 1004. The satellite velocity can be determined by any 
number of known methods. For example, the velocity may be computed from 
phase shifts in the carrier wave of die navigation signal (using accumulated 
delta range (ADR) techniques). 

At step 1006. steps 1002 and 1004 are repeated for times tj, tj. (4. (5. 
The velocity (v) and pseudorange (PSR) for the satellite at times t|, t2 and 
are then used in conjunction with the known position of the base station 
(B,.By,B^ at step 1008 to compute a first estimated position (x,y,z)3 of the 
satellite at time I3 using the following equations: 

(X - ♦ (y - Bp* (PSR^ EQ. ll" 

(X - 5, - v^-Atj^)2 * (y - By - Vy, Atj^)» * ^ 
iz-B. - V^'Lt^f = (P5^)2 



(X - B, - y^ A^ - v^ Af,^)* + (y - B, - v^ A^ - Vyi't^t^f * 

EQ. 13 

where: v^, v^, Vj2 - the x, y, and z components, • 
req)ecoveIy, of velocity for the satellite at time t^. 

Vjj, Vy,, v,| s the X, y, and z components, 
respectively, of velocity for the satellite at time t^. 

A«2 J = t3 - t2 
Ati^«t2-ti 

At stq> 1010, a second estimated position (x,y,z)4 of tiie satellite is 
computed at time t4 using the pseudorange and velocity data for times t2. ^ 
and 14. At step 1012, a third estimated position (x,y,z)5 of die satellite is 
computed at time using the pseudorange and velocity data for times t^, 
and 15. Steps 1010 and 1012 are performed identically to step 1008. The 



-22- 



esiimated satellite positions for times t^, (4, and are then used to predict an 

orbital path for the satellite at step 1014. 

Once the orbital path of the satellite has been predicted, the data may 

be used in place of the satellite ephemeris data to accurately determine the 
5 position of the satellite. This is illustrated at step 1016 where the predicted 

orbital parameters are used to predict the position of the satellite at a next time 

t^. Because this method computes a satellite position widiout relyiqg on 

satellite ephemeris data, vehicle position estimates may be made firee from die 

negative effects of selective availabili^. 
10 Stq>s 1002-1014 may be rq)eated to continuously refine die predicttd 

orbital path of a satellite as illustrated in flow chart 900 of Figure 9. 

The method of the invention relies on the following assumptions: (1) 

each satellite is deployed in a fixed orbit; and (2) all biases, e.g., clock and 

atmospheric, can be initially corrected. Atmospheric biases are corrected 
IS using a differential GPS system. If a differential system is not used, then tiie 

initial position of vehicle 210 must be accurately known. Moreover, in die 

case of such an qien-ended system, tiie vehicle cannot be run for long periods 

of time. That is, periodic initialization is required. 

Note that clock biases have been omitted from tiie equations set forth 
20 above to simplify discusaon. If present (i.e., a precise dock is not used), 

then clock biases may be induded in die equations of the embodiments sel 

fortii above. The result will be tiiat an additional equation will be required to 

solve for the clock bias. 

Note also that the predicted orbital parameters derived using tiie 
25 invention are valid at most for one pass of tiie satellite across tiie sky. The 

next time die satellite comes into view, all parameters must be recomputed. 
As discussed above, the computed position of a satellite can also be 

used to check die integrity of die satellite ephemeris data. That is, ephemeris 

data from the satellite can be compared to die predicted data for consistency. 
30 If the predicted position is approximately equal to the ephemeris indicated 

position, tiien die GPS data for SVu is assumed to be VALID or GOOD. If, 



however, the ephemeris indicated position is not approximately equal to the 
predicted position of satellite SV^, then the GPS data is probably INVALID 
or BAD. By "approximately equal to", it is meant equal to within a pre- 
determined tolerance range. 
5 Heretofore, preferred embodiments of the invention have been 

described. Persons skilled in the art, however, will recognize a variety of 
iaddidonal ways of piactidng the invention. For example, with reference to 
steps 702 and 704 of Figure 7, a variety of methods may be used to accurately 
determine the posiuon of a satellite. These include using four base stations (or 

10 vehicles having known positions) to precisely triangulate on tfie position of « 
satellite using data from a single time without relying on die ephemeris data 
broadcast by the satellite. It is possible that orbital parameters computed in 
this fashion could be accurately used for as long as several days. 

Note that tiie embodiments of the invention discussed above deal 

15 primarily with monitoring die integrity of the ephemeris data or leplaciiig the 
q)hemeris data widi predicted orbital parameters. However, tiie pseudorange 
data, i.e., die encoded transmission time of a signal, transmitted by a sateUite 
ihay also be corrupt. Bad pseudorange data will be monitored and corrected 
or eliminated when a best position estimate is computed using ti»e diffierential 

20 system (see flow chart 600). The integrity check of the pseudorange data can 
be done by the base station in step 609 or by the vehicle in step 610 (sec 
Figure 6) where Kalman filtering will reject out of lange data (i.c., a sudden 
step in position). Thus, the preseiit invention provides a means for roomtoting 
die integrity of boUi ephemeris data and pseudorange data broadcast by a GPS 

25 satellite. 
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1. A nethod for determining the position of a satellite 
in a satellite based navigation system using a receiver 
having a known position, the method comprising the steps 
of: 

receiving, from the satellite, a plurality of 
navigation signals at the receiver; 

determining a plurality of mean satellite positions 
from the navigation signals; 

computing orbital parameters for the satellite from 
the plurality of mean satellite positions; and ^ . 

predicting the position of the satellite at a time t^ 
from the orbital parameters. 

2. The method of claim 1, wherein each of the plurality 
of navigation signals is received at the receiver at a 
different time. 

3. The method of claim 2, wherein the step of computing 
comprises performing a best fit curve approximation. 

4. The method of claim 1, wherein the step of determining 
mean satellite positions comprises the steps of 
triangulating to determine the position of the satellite 
using the pseudoranges and the known position of each 
receiver; and 

repeating the signal receiving and triangulating steps 
to determine a plurality of positions of the satellite. 

5. The method of claim 2, wherein: 

the navigation signals are received at three different 
times; 

satellite velocities and pseudoranges are calculated 
for each of the receiver navigation signals; and 

the orbital parameters are calculated using the 
calculated velocities and pseudoranges. 
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6. A method for determining the position of a satellite 
in a constellation of such satellites of a satellite based 
navigation system, the method comprising the steps of: 

determining a first receiver position at a time t, 
using the constellation of satellites; 

determining a second receiver position at a tine tj 
using the constellation of satellites; 

determining a third receiver position at a time t, 
using the constellation of satellites; 

determining a fourth receiver position at a time t^ 
using the constellation of satellites; 

determining a fifth receiver position at a time- 1, 
using the constellation of satellites; 

selecting one of the satellites from the 
constellation; 

computing a first mean satellite position for the 
selected satellite using data from times t,, t^, and t3; 

computing a second mean satellite position for the 
selected satellite sing data from times t^, tj, and t^; 

computing a third mean satellite position for the 
selected satellite using data from times t,, t^, and t,; 

computing a set of orbital parameters for the selected 
satellite using the first, second, and third mean satellite 
positions; and 

predicting the position of the selected satellite at 
a time t„ using the orbital parameters. 

7. The method of claim 5 or claim 6, further comprising 
the step of: 

comparing the predicted position of the selected 
satellite at time t„ with a position indicated by ephemeris 
data of the selected satellite at time t„ to monitor the 
integrity of satellite ephemeris data. 

8. The method of claim 6, wherein each step of 
determining a receiver position comprises the steps of; 
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receiving a first navigation signal from a first 
satellite; 

computing a first pseudorange and a first satellite 
position based on the first navigation signal; 

receiving a second navigation signal from a second 
satellite; 

computing a second pseudorange and a second satellite 
position based on the second navigation signal; 

receiving a third navigation signal from a third 
satellite; 

computing a third pseudorange emd a third satellite 
position based on the third navigation signal; ^ . 

computing an estimated receiver position based on the 
pseudoranges and the satellite positions using a 
triangulation technique; 

refining the estimated receiver position based on bias 
data from a base station to produce a first refined 
receiver position; and 

refining the first refined receiver position using 
data from an inertial navigation system associated with the 
receiver to produce a second refined receiver position. 

9. The method of claim 8, wherein each the step of 
computing a meeui satellite position comprises the steps of: 

computing a refined pseudorange for the selected 
satellite at a first time using the second refined receiver 
position and a position of the selected satellite indicated 
by ephemeris data; 

repeating the step of computing a refined pseudorange 
for a second time; 

repeating the step of computing a refined pseudorange 
for a third time; and 

computing a mean satellite position for the selected 
satellite for the first, second and third times from the 
refined pseudoranges and the second refined receiver 
positions. 
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10* An apparatus for use with a vehicle for determining 
the position of the vehicle relative to the center of the 
Earth using navigation signals from a Global Positioning 
System (GPS) which includes a plurality of satellites 
orbiting the Earth, the apparatus comprising: 

first means r having a known position, for receiving 
the navigation signals from the plurality of satellites and 
for computing a first pseudorange and a velocity for each 
satellite at a plurality of discrete time intervals; 

second means for receiving the first pseudoranges and 
velocities for the plurality of discrete time intervals for 
each satellite and for computing orbital peurameters tor 
each satellite therefrom; and 

third means, for computing a position of each 
satellite from the orbital parameters. 

11. The apparatus of claim 10, wherein the first means 
comprises a first GPS receiver and a first GPS processor 
located at a base station. 

12. The apparatus of claim 11, wherein the second means 
comprises a second GPS processor mounted on a vehicle. 

13- The apparatus of claim 12, wherein the second means 
comprises a second GPS receiver coupled to the second GPS 
processor, the second GPS receiver adapted to receive the 
navigation signals from the plurality of satellites, to 
compute a second pseudorange for each satellite, and to 
provide the second pseudoranges to the second GPS 
processor, the second GPS processor adapted to receive the 
second pseudoranges and the orbital parameters and to 
compute an estimated position of the vehicle therefrom. 

14. An apparatus for use with a vehicle for determining 
the position of the vehicle relative to the center of the 
Earth using navigation signals from a Global Positioning 
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System (GPS) which includes a plurality of satellites 
orbiting the Eaith, the apparatus comprising: 

first means, mounted on the vehicle, for receiving the 
navigation signals from the plurality of satellites and for 
computing the position of the first, means based on 
ephemeris data and pseudoranges computed from the 
navigation signals; and 

second meems for monitoring the integrity of the 
ephemeris data and for determining if any of the ephemeris 
data is corrupt. 

15. The apparatus of claim 14, further comprising:- - 
third means for compensating for any corrupt ephemeris 

data when computing the position of the first means. 

16. A method substantially as described with reference to 
the accompanying drawings. 

17. An apparatus siibstantially as described with reference 
to the accompanying drawings. 
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